/*
 * ServoMotor.h
 *
 *  Created on: Nov 21, 2013
 *      Author: Administrador
 */

#ifndef SERVOMOTOR_H_
#define SERVOMOTOR_H_


//Function Prototype
void vdfn_ServoInit(void);
void u16fn_ServoControl(uint16);
void u16fn_ServoMovement_Slow(uint16);
void u16fn_ServoMovement_Fast(uint16);
void vdfn_ServoTest(void);


//Servo Variables
uint16 Servo_Reference,Servo_Past,Servo_Vector;
//P_Controller
uint16 Servo_Kp,Servo_Degree;
uint32 Servo_Value;
sint16 Servo_Error,Servo_Controller;
//Test
uint16 Servo_Value_Test;


#endif /* SERVOMOTOR_H_ */
